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ABSTRACT 


In multi-vehicle mine hunting operations, it will be necessary at times for one 
vehicle to loiter at some point while gathering communications of data from other 
vehicles. The loitering behaviors of the ARIES Autonomous Underwater Vehicle have 
never been completely defined. The track that the vehicle chooses to maintain station 
while circling around one specific point for an extended period of time may be sometimes 
random and unpredictable, unless defined in terms of specific tracks. Simulations were 
run and analyzed for various conditions to record the tendencies of the vehicle during 
different current conditions and approach situations. The stability of the Heading 
Controller was then analyzed in order to predict the position where the Line of Sight 
Guidance algorithm becomes unstable. The data obtained through the simulations 
supports and explains the tendencies ARIES exhibits while circling around a loiter point. 
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I. INTRODUCTION 


A. BACKGROUND 

As Autonomous Underwater Vehicle (AUV) technology advances, mission 
objectives in a military environment will become more enhanced. Specifically, minefield 
mapping and mine reconnaissance scenarios will utilize AUVs in order to ensure 
personnel safety. As the possibility of military conflict continues throughout the world, 
the need for capable mission objectives for AUVs becomes imperative. AUVs will be 
involved with complex and dynamic mission assignments where data exchange between 
vehicles occurs frequently and objectives can change often. 

A loitering technique will be introduced in a vehicle’s mission capabilities to 
attempt to increase an AUV system objective capabilities. This will allow the vehicle to 
perform in a dynamic environment where data exchanges and changing mission 
objectives are to be completed. Loitering parameters will be introduced in the 
programming of the mission and will be executed upon a transition criteria being met. 
Such criteria are listed: 

1. Receiving a command from the control station to proceed to a loiter station for 
data transfer or for further tasking parameters. 

2. Upon mission abort from time out procedures or any other abort parameters 
with the exception of immediate surfacing abort criteria. 

3. Upon completion of current mission assignment. 

Loitering stations will be defined and introduced into the mission assignment 
through coding prior to the execution of the mission. There will be a specific loiter 
station for each leg of the AUV’s defined track. If the AUV meets the criteria listed 
above, it will proceed to the defined loiter station for the respective leg and wait further 
instructions. 

Before being able to test loitering missions with the AUV, modeling of the 
vehicle must be researched to accurately to predict vehicle characteristics during such 
assignments. Accurate guidance calculations become imperative in order to accomplish 
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the dynamic mission parameters set forth. The vehicle must reach its intended loiter 
point and maintain station until further instructions are received. Also, the effect of 
hydrodynamic forces such as waves and currents acting on the vehicle must be taken into 
consideration when attempting to predict the tendencies of the vehicle proceeding and 
maintaining position at a loiter station. If the vehicle cannot maintain station at a 
loitering point due to the forces acting on it then a different stationing concept must be 
conceived. 

B, SCOPE OF THIS WORK 

The loitering technique of the ARIES is not thoroughly understood. The vehicle 
does not maintain station at one point very well. The track that the AUV follows during a 
loiter maneuver is random and unpredictable. This thesis is written to break down the 
reasons why ARIES performs in such a way and what alternatives can be made to prevent 
such actions. 

Chapter II will explain the general background data of ARIES. This will include 
current command and control configuration, hardware and software architecture, and a 
general explanation of the control laws that govern the vehicle’s movements. 

Chapter III will discuss the theory and benefits behind the implementation of 
loitering stations along each leg of a mine mapping mission. The parameters to transition 
to a loiter station will also be discussed in detail. 

Chapter IV will consists of simulation data that contains various conditions that 
ARIES could encounter in an actual run. The simulations show the relevance of current 
direction acting on the vehicle and which conditions are optimal for ARIES. 

Chapter V will justify the reason for the loitering behavior that the AUV exhibits 
when attempting to loiter around a point. 

Chapter VI is a stability analysis that supports the theories that the Eine of Sight 
Guidance is unstable when approaching the loitering point. 

Chapter VII discusses options to correct for the loitering behavior and other 
alternatives to research in the future. 
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II. GENERAL BACKGROUND ON THE ARIES AUV 


A. VEHICLE DESCRIPTION 

(This section is largely taken from [1], but is repeated here for convenience of the 
reader). Construction on ARIES began in the fall of 1999 and was fully operational in 
the spring of 2000. The ARIES vehicle is a shallow water communications server 
vehicle with a Differential Global Positioning System (DGPS) and a Doppler aided 
Inertial Measurement Unit (IMU) / Compass navigation suite. Eigure 1 shows the 
command and control system as it exists today. 

Coinniamt »iul C’oHlro} 


Jor./r* network command and CONTROL: 

,1 ^ (yyv SCR FA CE FOR NA I IGA TION 

CORRECTIONS AND CONTROl 



KFSCtnmSKiBiio*. Ayg5 incwimtea >y tuato whoi sunai-ML muiid«wii weJ ty sui ' 





Eigure 1. Current Command and Control. [1] 

ARIES measures approximately 3 meters long, 0.4 meters wide, 0.25 meters high, 
and weighs 225 kilograms. A fiberglass nose that becomes flooded is used to house the 
external sensors, power switches, and status indicators. The hull is constructed of 0.25 
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inches thick 6061 aluminum that contains all the electronics, computers, and batteries. 
The ARIES is powered by six 12-volt rechargeable lead acid batteries and the endurance 
is approximately 3 hours at a top speed of 3.5 knots, or 20 hours hotel load only. ARIES 
can operate safely at a depth of 30 meters, however, through finite element analysis it has 
been shown through hull strengthening that ARIES can operate safely up to 100 meters. 
Eigure 2 shows the major hardware components of the ARIES. 
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Figure 2. Hardware Components. [1] 

Propulsion is achieved using twin 0.5 Hp electric drive thrusters located at the 
stem. Heading and depth is controlled using upper bow and stern mdders and a set of 
bow and stem planes, respectively. Although not currently installed on ARIES, vertical 
and lateral cross-body thmsters can be used to control surge, sway, heave, pitch, and yaw 
motions during slow or zero speed maneuvers. 
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The navigation sensor suite eonsists of a 1200 kHz RD Instruments Navigator 
Doppler Veloeity Log (DVL) that also eontains a TCM2 magnetic compass. This 
navigation suite measures vehicle altitude, ground speed, and magnetic heading. Angular 
rates and accelerations are measured using a Systron Donner 3-axis Motion Pak IMU. 
While surfaced, differential GPS (Ashtech G 12-Sensor [2]), accuracy 40 centimeters, is 
available to correct any navigational errors accumulated during the submerged phases of 
a mission. In addition, and because of inaccuracies in the TCM2 compass, a Honeywell 
HMR3000 magnetic-restrictive compass, corrected by a deviation table, is used as the 
primary heading reference standard. Experiments have shown that the deviation table 
maximum error is approximately 4 degrees in some orientations. 

A fixed wide-angle video camera (Deep Sea Power and Light - SSI00) is located 
in the nose and connected to a Digital Video Cassette (DVC) recorder. The computer is 
interfaced to the recorder and controls the on/off and start/stop functions. The video 
image has the date, time, position, depth, and altitude superimposed onto it. 

A scanning sonar (Tritech ST725) or a profiling sonar (ST 1000) is used for 
obstacle avoidance and target acquisition/reacquisition. The sonar can scan continuously 
through 360 degrees of rotation or be swept through a defined angular sector. 

Freewave Radio Modems are used for moderate bandwidth (2000-3000 bytes/sec 
over 4 to 6 nautical miles with repeaters) command and control (C ), between command 
center and the vehicle when surfaced. Kermit file transfer protocol is used in the vehicle 
computer with Zmodem through Procomm protocol on the base station side. 
Experiments conducted have transferred data files between the surfaced ARIES, a Boston 
Whaler repeater station, and a base station command center. Radio modem connections 
require line-of-sight and are critically dependent on antennae height above ground. 

ARIES has an FAU acoustic modem installed onboard, details of which are 
provided in [3]. The successful operation of the modem is imperative if ARIES is to be 
used as a network server. Other modems could be installed in the same fashion as the 
FAU modem allowing for more than one modem to be used during the same mission. 
This would allow future networking links between different vehicles without an 
interoperable standard in place. 
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B. 


COMPUTER HARDWARE 


The dual computer system unit consists of two Ampro Little Board 166 MHz 
Pentium computers with 64 MB RAM, four serial ports, a network adapter, and a 2.5 GB 
hard drive each. Two AC/DC voltage converters for powering both computer systems 
and peripherals are integrated into the computer package. The entire computer system 
draws a nominal 48-Watts. Both systems use TCP/IP sockets over thin wire Ethernet for 
inter processor communications and connections to an external LAN. The sensor data 
gathering computer is designated QNXT, while the second is named QNXE and executes 
the various auto-pilots for servo level control. Both computers are used as the baseboard 
for a stack of Diamond Systems PC-104 data acquisition boards. 


C. COMPUTER SOFTWARE 
1, Architecture 


Figure 3 shows a diagram outlining the modular, multi-rate, multi-process 
software architecture. 



Figure 3. Dual Computer Software Architecture. [1] 
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This scheme is designed to operate using a single computer processor, or two 
independent eooperating proeessors linked through a network interface. Splitting the 
processing between two computers can significantly improve eomputational load 
balancing and software segregation. A dual computer implementation is presented here, 
since, in the ARIES, eaeh proeessor assumes different tasks for mission operation. Both 
computers run the QNX real time operating system using synehronous soeket sender and 
receiver network proeesses for data sharing between the two. On eaeh proeessor, inter- 
proeess communication is achieved using semaphore controlled shared memory 
structures. Deadloeks and raee eonditions are explicitly eliminated by the eareful use of 
semaphores in this system design. AT boot time, the network proeesses are started 
automatically and all shared memory segments are created in order to minimize the 
amount of manual setup performed by the user. 

All vehicle sensors are interrogated by separate, independently eontrolled, 
concurrent processes, and there is no restriction on whether the proeesses operate 
synchronously or asynchronously. Since various sensors gather data at different rates, 
eaeh process may be tailored to operate at the aequisition speed of the respective sensor. 
Each process may be started, stopped, or reset independently allowing easy 
reeonfiguration of the sensor suite needed for a given mission. All proeesses are written 
in C. 

To allow synchronous sensor fusion, each process contains a unique shared 
memory data structure that is updated at the specific rate of each sensor. All sensor data 
are accessible to a synchronous navigation process through shared memory and is a main 
feature of the software architeeture. Incorporated into the navigation process is an 
extended Kalman filter that fuses all sensor data and computes the real time position, 
orientation, velocity, etc, of the vehicle. The dual compute implementation uses one 
processor for data gathering and running the navigation filters, while the seeond uses the 
output from the filters to operate the various auto-pilots for servo level control. Once the 
state information is computed, it is transmitted to the second computer over standard 
TCP/IP sockets. 
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2 . 


Mission Control Modes 


Vehicle behaviors are determined by a pre-programmed mission script file. This 
is parsed in the QNXE computer by the processes Exec. The file contains a sequential 
list of commands that the vehicle is to follow during a mission. These commands may be 
as simple as setting the stern propulsion thruster speeds, to more complex maneuvers 
such as commanding the vehicle to repeatedly fly over a submerged target at a given GPS 
coordinate using altitude and cross-track error control. 


D, AUTO PILOT CONTROL LAWS 

The ARIES uses four different auto pilots for flight maneuvering control. They 
consist of independent diving, steering, altitude above bottom, and cross-track error 
controllers. All four auto pilots are based on sliding mode control theory and each mode 
(i.e. diving, steering, etc) is de-coupled for ease of implementation and design. A 
reference for the details of controller design methodology may be found in (Healey and 
Eienard, 1993, [4]). The designers of the ARIES have found that Sliding Mode 
controllers are more simple to use and implement with minimal tuning than PID, EQR, 
fuzzy and heuristic control. 

1, Depth Controller 

Since the vehicle depth can be independently controlled by the dive planes alone, 
the diving controller may be modeled by a linearized system with a single generalized 
input control, u(t), generating a pitch-dive control distributed to bow and stern planes in 
an equal and opposite amount, and is of the form 

x = Ax + bu, (1) 

and for the ARIES, the dynamics are given by the system of equations 


q{t) 


1.3899 

-0.0032 

0“ 

q{t) 


“-2.609r 


m 

= 

1 

0 

0 

e{t) 

+ 

0 

+ (distur) 

Z{t)\ 


0 

-u 

0 

Z{t)\ 


0 J 
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where, q{t) is the piteh rate, 0{t) is the piteh angle, Z{t) is the depth in meters, and 
is the stern plane angle in radians. 17is the nominal longitudinal speed of the 

vehiele expressed in (m/see) and a value of 1.8 m/see is used. Although the bow and stern 
planes may be independently eontrolled, eurrently both sets of planes operate as eoupled 
pairs sueh that the eommand to the bow planes is —d^p{t). Notiee that the heave 

veloeity, w, equation is ignored, as also are its effeets on the q and Z equations of motion. 
They are eonsidered to be disturbanees. The reduetion of the system to third order 
ereates a simplifieation that is both valid and useful. 

The sliding surfaee is then formed as a linear eombination of state variable errors 
in the usual way. Ignoring any non-zero piteh angle and rate eommands, the sliding 
surfaee polynomial beeomes 

a{t) = 0.7693q{t) + 0.6385e{t)+ 0.072488(2^^^ - Z(t)) (3) 

and the eorresponding eontrol law for the stern planes is 

d^^(t) = 0.4994(-0.4105q(t) + 0.10860(1) + q tanh(C7(t) / ^) (4) 

where, 7] = 1.0 and ^ = 0.5 . 

2. Altitude Controller 

In order to eontrol the vehiele altitude above the bottom designated h(t), we 
simply need to ehange some of the signs of the terms from the diving equations. Noting 
the sign differenee of the piteh angle and rate eoeffieients, this results in the following 
sliding surfaee 

a(t) = -0.7693q(t) - 0.63850(7) + 0.0724(h^^^ - h(t)) (5) 

The stern plane eommand for altitude eontrol is 

(t) = - 0.4994( 0.4105q(t) - 0.10860(7) + Tpinh(a(7)l^)) (6) 

where, t] = 1.0 , ^ = 0.5 , and h(7) in meters replaees the vehiele depth, Z. 
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3. Heading Controller 


By similar reasoning, and to eliminate the need to feedbaek the sideslip veloeity, 
we argue that a seeond order model is suffieient. The side-slip effeets are treated as 
disturbanees that the eontrol overeomes. Thus, the heading model beeomes 

r{t) = ar(t) + bS^ (t) + {disturbances) 

m = r{t) 

where, r{t) is the yaw rate and dXt) is the stem mdder angle. The eoeffieientsa and b 
have been determined using system identifieation teehniques from past in water 
experiments and are a = -0.30 rad/sec and b = -0.1125 rad/sec . The stern and bow 
rudders operate in the same way as the planes, therefore, the eommand to the bow mdder 
is -^,(0- 

Notiee that in order to use this steering law, - y/) must lie between ± 180 ^, 
and is de-wrapped as needed in order to make that happen, and ignoring any non-zero 
eommand yaw rate, the sliding surfaee is defined by 

a{t) = - 0.9499 r{t) + 0.1701{w,,^ - Wif)) (8) 

The stern mdder eommand for heading eontrol is 

S^{t) = -1.542{2.5294r{t) + rj tanh{a{t)/^)) (9) 

where, r} = 1.0 and ^ = 0.5. 

4. Cross Track Error Controller 

To follow a set of straight line traeks that form the basis of many guidanee 
requirements, a sliding mode eontroller is presented that has been experimentally 
validated under a wide variety of eonditions. Other works have studied this problem for 
land robots, (for example, Kanayama, 1990) and usually develop a stable guidanee law 
based on eross traek error. Here, with Figure 4 as a guide to the definitions, we use a 
eombination of a Line of Sight Guidance (Healey, Lienard, 1993) and a Cross Track 
Error Control for situations where the vehicle to track heading error is less than 40 
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degrees. For the line of sight guidance with large heading error, a separate line of sight 
controller is used. 

One of the shortcomings of the heading controller defined above is that it has no 
ability to track a straight line path between two way points since it can only regulate the 
vehicle heading. It is desired to command the vehicle to track a line between two way 
points with both a minimum of error from the track and heading error between the 
vehicle and the track. This type of regulation is known as cross track error control and 
the variable definitions are illustrated in Figure 4. 



Figure 4. Cross Track Error Definitions. [1] 

The variable of interest to minimize is the cross track error, £{t ), and is defined 
as the perpendicular distance between the center of the vehicle (located at {X{t),Y{t) ) 
and the adjacent track line. The total track length between way point i and i-1 is given by 

A ~ ^ ) ~ ^wpt(i-l )) C^wptii) ~'^wpt(i-l)) (10) 

where, the ordered pairs Y^^ta)) and (are the current and 

previous way points respectively. The track angle, , is defined by 


11 



(11) 




trk{i) 


1 ^^^ i^wptii) ^wptii-l)’ ^wpt(i) ^wpt{i-l)) 


The cross track heading error ip{t)cTE(n segment is defined as 


CTE(i) 


W(t) 


CTE{i) 




trk(i) 


( 12 ) 


where, (^^(Oc 7 ’i-(o must be normalized to lie between ±180°. The difference between the 
current vehicle position and the next way point is 


■^iOwpt(i) ~ ^ wpt(i) 


X{t) 


7(0 


wpt(i) 


Y.P,, - m 


(13) 


With the above definitions, the distance to the way point projected to the track 
line S{t). , can be calculated using 


S{t\ ■^i^)wpt(i)i-^wpt(i) ■^wpt(i-l)) ^ wpt(i) ^^wpt(i) '^wptii-l ) )/Z, (14) 

therefore, S{t). ranges from 0-100% of L.. 

The cross track error £{t) may now be defined as 


£{t) = S,it)sinidpit)) 


(15) 


where, <5^(0 is the angle between the line of sight to the next way point and the current 
track line given by 


^,(0 


tan-'(10.r(n 


— X 

wpt(i) wpt(i—l)-' 


■tan'(7(0 


wpt{i) 


' ^iOwpt(i)) 


(16) 


and must be normalized to lie between ±180°. 


With the cross track error defined, the sliding surface can be cast in terms of 
derivatives of the errors such that 

£{t) = £{t) 

£{t) = U sin{\jf{t)cTE(i)) 

£{t) = Ur(t) cos{y/{t)cTEii)) 

£{t) = Ur{t)cos{y/{t)cTEii))-Ur{ty sin{y/{t)cjEd)) 
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The sliding surface for the cross track error controller becomes a second order 
polynomial of the form 

<7(0 = £{t) + X,£{t) + /l^fCO (17) 

The condition for stability of the sliding mode controller is 

<7(0 = £\t) + /i;f(0 + ^2^(0 = - (18) 


and to recover the input for control, the heading dynamics Equation (7) may be 
substituted into Equation (16) to obtain 


U (ar(0 + bd^)cos{y/{t)^Ed)) -Uritf sin{y/{t) cteh)) + ^iUr{t)cos{y/{t )) 

+ X 2 U sini}!/if) QEE(i )) 

(19) 


Rewriting Equation (15), the sliding surface becomes 

t7(0 = U r{t)cos{^{t)cEEii)) + ^lU sin{ii/{t)cTEd)) + 4^(0 

The rudder input can be expressed as 




1 


Ubcosiy/it)cTE(i)) 


{-Uar{t)cos{i//{t)crE(i)) 


y -vr \-JCTE(i)J j 

+ ^{r{t)y sin{^{t)cTEii) ) - ^,Ur{t) cos{^{t)cTE(i) ) 


Xp sin{ii}{t)cTEd))-n{<^it)l<P)) 


( 20 ) 


( 21 ) 


where, X, = 0.6, X 2 = 0.1,7] = 0.1, and (j) = 0.5. To avoid division by zero, in the 
rare case where cos{y/{t)(.TE) = 0.0 {i.Q. the vehicle heading is perpendicular to the track 
line) the rudder command is set to zero since this condition is transient in nature. 

5, Line of Sight Controller 


When the condition arises that the magnitude of the cross track heading error 
|(^(0c7’£(/)| exceeds 40^*, a Eine of Sight Control (EOS) is used. In this situation, the 
heading command can be determined from 

V^(0com(LOS) = tan-‘(f(0,.,,(,,X(0.,.(o) (22) 
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and the LOS error from 


W(f)LOS W(f)com(LOS) ( 23 ) 

and the eontrol laws used for heading eontrol, Equations (8,9) may be used. 

Two eonditions may be true for the waypoint index to be ineremented. The first 
and most usual ease is if the vehiele has penetrated the way point wateh radius . 

Seeondly, if a large amount of eross traek error is present, the next way point will beeome 
aetive if the projeeted distanee to the way point S'(t), reaehed some minimum value 

SminU) , sueh that 

if + (F(0,II S(t). < then 

Activate Next Way Point 

In water experimental results using the eontrollers presented above will now be 
presented in the next seetion. 


E. NAVIGATION 

The ARIES vehiele uses an INS / DOPPLER / DGPS navigational suite and an 
Extended Kalman Eilter (EKE) whieh was developed and presented in ([5] and [6]), and 
may be tuned for optimal performanee given a set of data. The main impediments to 
navigational aeeuraey are the heading referenee and the speed over ground measurement. 
In this system, the heading referenee is derived from both the Honeywell eompass and 
the Systron Donner IMU, whieh provides yaw rate. The fusion of the yaw rate and the 
eompass data leads to an identifieation of the yaw rate bias, whieh is assumed to be a 
eonstant value. The eompass bias, which is mostly dependent on vehicle heading relative 
to magnetic north, is identified in the EKE ([6]), using DGPS positions when surfaced. 
When submerged, the position error covariance grows, but is corrected on surfacing. A 
relatively short surface time, (for example, 10 seconds) allows the filter to re-estimate 
biases, correct position estimates and continue with improved accuracy. As a 
demonstration, the ARIES vehicle was operated in Monterey Bay, in a series of runs 
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including a dive-surface-dive-surface sequenee. Figure 5, below shows a plot of vehicle 
position in an exercise where the vehiele is commanded to follow a track at depth, eome 
up for a DGPS correction, then follow the bottom at an altitude of 3m, while a video is 
recorded from a down-looking camera. The vehiele then surfaees to get a second fix 
before turning round and repeating the exercise from the complementary heading. In this 
plot, the vehiele trajeetory is designed to fly over the Monterey Inner Shelf Observatory 
(MISO) Instrument Frame plaeed in 12 meters of water approximately 0.5 kilometers 
from shore with estimated GPS position used to design the approaeh lane. The video 
taken as the vehiele flies over the MISO is designed to provide identifieation details of 
the arbitrary object given its approximate DGPS location point. 


VEHICLE PATH 



Figure 5a. Vehiele Path showing loeations where the GPS position fixes were 
obtained by surfaeing for 20 seeonds (asterisks). Figure 5b. Depth Response during run 
that elearly shows the DGPS pop up maneuvers. [1] 


VEHICLE PATH 



Figure 6. Close up of the final surface showing the filter solution together with the 


DGPS measurement at the surface. [1] 
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In Figure 6, a close up of the final surfacing maneuver shows that there is great 
consistency in estimating the true DGPS data point as seen by the AshTec G-12 unit on 
board. The difference between the Kalman Filter solution and the DGPS data points 
while surfaced is sub meter precision. However, the difference between the dead 
reckoning solution underwater is a few meters off the mark. 

In Figure 7, the number of visible satellite vehicles seen by the DGPS unit are 
shown to evolve quickly. Within 10 seconds, 9 satellites are being used to compute the 
position solution. 



Figure 7. Time History of the response of the number of visible GPS satellites 
during the surface phase shown in Figure 6. [1] 



Figure 8. Compass Bias Estimate versus Time. [1] 
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Figure 8 shows the response of the heading bias estimate from the EKF for the 
entire run. At eaeh surfaee approximately 10 DGPS points are obtained whieh rapidly 
eorreets the compass bias. However, as is seen, compass corrections in the neighborhood 
of 5 degrees are still needed to predict correctly the vehicle positions. This is an 
indication that further corrections of the compass deviation table are needed. The 
remaining question is whether or not the deviations are predictable or random. While 
some additional runs suggest that there may be some degree of consistency, it remains to 
be shown conclusively. 
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III. LOITERING PARAMETERS AND IMPLEMENTATION 


A. GENERAL THEORY 


As discussed earlier, a series of parameters must be met before the ARIES can 


transition to a loiter point. Figure 9 gives a graphic description of the transitions that 



Figure 9. Foiter Fogic. [7] 

If the ARIES “times out” prior to reaching the next waypoint, meaning the AFTV 
does not reach the next waypoint in the allotted amount of time, or if the vehicle receives 
a command (CMD) from the controlling station, the vehicle will proceed to the respective 
loiter point, depending on the leg that ARIES is on. Normally the AFIV aborts its 
mission completely if there is “time out” prior to reaching the next intended waypoint. 
Having the vehicle proeeed to a loiter point instead of aborting the entire mission allows 
the vehicle to maintain station at the loiter point and receive new mission parameters 
and/or commands from the control station instead of aborting the entire mission all 
together. If the criteria set forth for transition to the next waypoint is met, the vehicle 
will proceed as programmed until commanded by the control station to proceed to a loiter 
point. This logic allows flexibility for the vehicle to continue on its mission until the 
control station requires it to break off its pre-programmed track because of possible 
rendezvous with another vehicle for data transfer or adjusting mission parameters. 
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B. 


LOITER POINT MAPPING 


Generally, for a given mine mapping mission, the vehiele will have a series of 
tracks to follow in sequence termed “legs”. Figure 10 below is a typical diagram of the 
legs ARIES would follow for a mine mapping mission. 


Vehicle Mission Track 



Figure 10. Typical Legs for a Mine Mapping Mission. 

The idea for implementing loitering with the ARIES is to have pre-programmed 
loiter points within the program itself. More specifically, each leg would have a specific 
loiter point designated to it. As the ARIES travels down each leg, there is a respective 
loiter point attached to the leg. Figure 11 gives a graphical description of the loiter points 
and their respective legs. Note that the position of the loiter points are arbitrary and 
should be determined by the programmer according to the mission objectives and 
parameters. 
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Vehicle Mission Track With Loiter Points 



Figure 11. Loiter Points and their Respective Legs. 

Positioning the loiter points in this manner allows the vehicle to transition to a 
loitering point and receive further instructions in the shortest amount of time. As the 
AUV transitions to the next leg, the previous loiter point is dropped and the new loiter 
point is picked up with the current leg. As the vehicle transitions to each leg, each loiter 
point is automatically transitioned with its respective waypoint. This reduces confusion 
for the control station when concentrating on command and control. 
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IV. LOITERING SIMULATIONS 


A. MATLAB SIMULATIONS WITH NO CURRENT 

A MATLAB program was modified to include a loiter point on the first leg of the 
track. At an arbitrary time along the first leg, the operator is given a choice to proceed to 
Loiter Point 1 or continue on track. Under real operating conditions the AUV would be 
interrupted during its mission and commanded to a respective loiter point. However, 
since MATLAB is not a real time operating program the program itself had to be 
interrupted to interpret the operator’s intentions. Below is a figure that shows what was 
explained above. 


Vehbb Track Data 



Figure 12. Arbitrary Position Along Track AUV is Ordered to Loiter Point. 

The simulation has an input break built into the program to find the operator’s 
intentions. At this point the operator either chooses to continue on track or to proceed to 
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a loiter point. The next figure shows the vehicle as it is commanded to proceed to a loiter 
point. 


Vehicle Track Data 



Figure 13. Vehicle Characteristics During a Loiter of 62 seconds. 

Once the vehicle is commanded to proceed to the loiter point, it uses its normal 
Line of Sight and Cross Track Error guidance to proceed to the loiter point. The watch 
radius around the loiter point is set to zero so that the ARIES “never reaches” the point 
and thus, continues to circle or loiter. Eigure 13 shows that ARIES maintains a tight 
bounded circular shape around the point of approximately 20 meters in diameter. As the 
AUV continues to loiter it should report its GPS position every 10-15 minutes to the 
control station in order to update the operators and correct itself for position errors. As 
ARIES is in the loiter, the control station can determine what and if mission parameters 
need to be changed such as, rendezvous with another vehicle, change the current track, or 
continue on the original track. 

Eigure 14 is a simulation that shows the vehicle as it continues from its loiter 
point back to the original track. 
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Vehicle Track Data 



Figure 14. Continue onto Original Track From Loiter Point 

Figure 14 shows how the ARIES can continue from its loiter point to its original 
track. ARIES has no problem transitioning from a loiter mission to resuming its 
previously programmed search mission. 


B. MATLAB SIMULATIONS WITH CURRENT 
1, Current Condition Simulation #1 

The results of the simulations change drastically when a current is introduced. 
Eor condition #1, a current of 0.3 kts at a direction of 135 degrees (Southeast) is 
introduced in the program. The vehicle continues to operate correctly as it travels down 
its pre-programmed search track and proceeds to the loiter point, but when it attempts to 
loiter around the designated point the vehicle no longer maintains a tight, circular shape. 
Eigure 15 shows the pattern that ARIES follows when current is introduced into the 
simulation. 
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Vehicle Track Data 



Figure 15. Loitering Track with Current for 25 seconds. 

The parameters for the Figure 15 simulation has the vehicle proceeding to the 
loiter point by making a heading change of approximately 90 degrees. The vehicle 
circles around the loiter point for approximately 25 seconds. The current causes the 
ARIES AUV to fall off its tight, circular pattern that we viewed in Figures 13 and 14. 
The pattern is still somewhat circular in nature, but as ARIES continues to attempt to 
drive over the loiter point, the vehicle’s track is slowly shifting to the south. Eigure 16 is 
a closer view of the vehicle’s track around the loiter point. 
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Vehicle Track Data 
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Figure 16. Close Up View of Vehiele Loiter Traek After 25 Seeonds with Current. 

From Figure 16, it is observed that the vehicle proceeds to the loiter point as 
commanded. Once it passes over the point it continues to circle because the loiter point 
has a radius of zero, therefore, the vehicle never reaches the “waypoint” and continues to 
try until it does. The set and drift of the current acts on the vehicle and the tight circular 
shape that ARIES exhibited with no current is shifted in a southerly direction. 

Figure 17a shows the vehicle track after 32 seconds. ARIES continues its circular 
pattern with a series of right turns until it is too far south of the loiter point and shifts the 
rudder. Now a circular pattern with a series of left turns exists. Eigure 17b shows the 
AUV at 35 seconds as it is in a series of left turns in its attempt to pass over the loiter 
point. 
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Vehicle Track Data 



Figure 17a. ARIES is south of the loiter point and begins to make a left turn after 32 

seconds. 
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Vehicle Track Data 



Figure 17b. ARIES in a Left Turn after 35 seeonds. 

Figures 17a and 17b begin to explain the “figure 8” tendeneies that the AUV exhibits 
when loitering around one specific point. During prior missions in open waters, ARIES 
would not maintain a tight circular shape, rather, it would conduct a series of “figure 8” 
maneuvers while maintaining station around a loiter point. Figure 18 below shows the 
rudder angle of ARIES as it travels along its original track and then when commanded to 
loiter. 
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Time vs Rudder Angle 



Figure 18. Rudder Angle of ARIES During Original and Loiter Traek. 

Figure 18 shows the rudder angle during the right and left turns as ARIES circles around 
the loiter point. At approximately 30 seconds the vehicle changes from right turns to left 
turns. 


The reason why ARIES knows to change from right turns to left turns lies within 
Equation (16) where, dp{t) is the angle between the line of sight to the next waypoint 

and the current track line given by 


Mt) 


■tan-'(f(0„,,(,-X(0 


— X ^ 

wpt{i) wpt{i—\')^ 


wpt{i)) 


(16) 


and must be normalized to lie between ±180°. Normalizing dp{t) allows the vehicle to 

pick the shortest route to the waypoint. In other words, instead of having the vehicle turn 
270 degrees to starboard to reach the waypoint, it only turns 90 degrees to port. 
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As the loitering time is increased, the ARIES continues to exhibit the “figure 8” 
track description for its loitering technique. As the current sets the vehicle in different 
positions, the AUV properly determines the shortest route to reach the loitering point. 
Figure 19 shows the vehicle loitering track at 50 seconds. It is hard to tell, but as the 
vehicle is in a port turn, it begins to pass the loitering point on the south side, with the 
loiter point on the starboard beam. It computes that the shortest way to the point is to 
starboard and makes the correct decision by turning right. 

Vehicle Track Data 
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Figure 19. Foitering Track after 50 seconds. 

Next, Figure 20 shows the rudder angle changing from a port turn to a starboard 
turn at approximately 45 seconds. 


t ^ ^ 

/ 

' // / 

' / 

I / /I \ ^ 

I I \y \ 

I / / ^ \ 

A: 

I 'V 

' s 
\ \ 

\ \ 


X . ik. 

^ A \ 

- - ^ \ 
vyy 




'A 

V ^ I 

- V' 

\ i 

^ / / 
/ / 

/ / 

7 7 
/ / 


/ 


31 















































































Time vs Rudder Angle 



Figure 20. Time vs Rudder Angle. 

2, Current Condition Simulation #2 

The loitering initiation position was adjusted and the results were very interesting. 
The point at which the vehicle transitioned to its loiter point was changed to the 
beginning of its original track so that it would proceed to its loiter point by traveling 
directly against the current. The loitering time was kept at 50 seconds. The results are 
below in Figures 21, 22, and 23. The vehicle has no trouble maintaining a relatively 
tight, circular bounded shape around the loiter point. ARIES maintains station around the 
loiter point with a continuous port turn with slight adjustments during station keeping. 
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Vehicle Track Data 



Figure 21. Loitering track after 50 seconds with vehicle proceeding into the SE 
setting current as it travels to the loiter point. 
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Vehicle Track Data 
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Figure 22. Loitering track after 50 seconds with vehicle proceeding into the SE 
setting current as it travels to the loiter point. 
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Time vs Rudder Angle 



Figure 23. Time vs Rudder Angle. 

The vehicle is able to maintain station on the loiter point much better as it 
proceeds into the onsetting current prior to loitering. Figure 24 below is the vehicle after 
loitering 125 seconds. 
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Vehicle Track Data 
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Figure 24. Loitering Track after 125 seconds. 

The vehicle is slowly shifting its loitering track towards the northeast, but it is 
much more regular in shape as time transpires than the previous condition. 

There appears to be a relationship with the approach to the loiter point and the 
direction of the current. 

3, Current Condition Simulation #3 

A simulation to establish a relationship between the loiter point approach and 
direction of the current was run. The direction of the current was changed to a 
Northeasterly direction of approximately 045 deg T and the approach to the loiter point 
was made later in the original track run so the vehicle would be traveling directly against 
the current again. Figures 25, 26, and 27 are the results of the test. 
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Vehicle Track Data 



Figure 25. Loitering track after 50 seconds with vehicle proceeding into the NE 
setting current as it travels to the loiter point. 
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Vehicle Track Data 



Figure 26. Loitering traek after 50 seconds with the vehicle proceeding into the 
NE setting current as it travels to the loiter point. 


Time vs Rudder Angle 



Figure 27. Time vs Rudder Angle. 
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From analyzing Figures 21-27, there appears to be a relationship between the 
loitering technique of the vehicle and the approach of the AUV to the loiter point as it 
relates to the direction of the current. 

4, Current Condition Simulation #4 

A simulation with a current traveling with the vehicle to the loiter point is created 
in Figures 28, 29, and 30. The ARIES exhibits the “figure 8” loitering technique in this 
current scenario. Current is 0.3 kts in a Northwesterly direction of approximately 315 
deg T with the approach to the loiter point being at the beginning of the mission track. 
The loitering simulation time is kept at 25 seconds because the loitering track gets too 
hard to distinguish. 


Vehicle Track Data 



Figure 28. Loitering Track after 25 seconds with a NW setting current. 
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Vehicle Track Data 
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Figure 29. Loitering Track after 25 Seconds with a NW Setting Current. 


Time vs Rudder Angle 
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Figure 30. Time vs Rudder Angle. 
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After analyzing the Figures 28-30, the shape of the loiter track at every turn with 
this current condition is in a “figure 8”. 

5, Current Condition Simulation #5 

The current speed was increased to 1 kt for the same situations in the simulations 
run earlier (Figures 15-30). Figures 31 and 32 below shows how the vehicle loitering 
characteristics change with an increase in the current speed. 


Vehicle Track Data 



Figure 31. Loitering Track after 90 Seconds with a SE Setting Current. 


41 


























































Vehicle Track Data 



Figure 32. Loitering Track after 90 seconds with a SE Setting Current. 

Figures 31 and 32 show that the vehicle continues to exhibit irregularities in the 
shape of the loitering track. The track above is a simulation of 90 second loitering time. 
The boundedness of the loitering is also increased to a diameter of approximately 38 
meters. 

6, Current Condition Simulation #6 

Next the direction at which the AUV proceeded to the loiter point was changed so 
that the vehicle traveled into the current as it approached the loiter point. Figures 33 and 
34 are the results. 
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Vehicle Track Data 



Figure 33. Loitering Track after 100 Seconds with a SE Setting Current. 
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Vehicle Track Data 



Figure 34. Loitering Track after 100 Seconds with a SE Setting Current. 

From Figures 33 and 34 again it is observed that when the vehicle proceeds to the 
loiter point traveling against the current the loitering track shape is in a more predictable 
manner. In this case, the shape becomes more semi-circular with a bounded diameter of 
approximately 33 meters. 

7, Current Condition Simulation #7 

The current direction was changed to a Northeasterly direction and the vehicle 
was again ordered to the loiter point by traveling directly into the onsetting current. 
Figures 35 and 36 are the results. 
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Vehicle Track Data 



Figure 35. Loitering Track after 100 Seconds with a NE Setting Current. 
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Vehicle Track Data 



Figure 36. Loitering Track after 100 Seconds with a NE Setting Current. 

Figures 35 and 36 again show that there is a relationship with the approach track 
to the loiter point and the current direction. The shape of the loitering track is semi¬ 
circular in nature and bounded with a diameter of approximately 33 meters as in Figures 
33 and 34. 

8, Current Condition Simulation #8 

The current direction was changed to a Northwesterly direction and the vehicle 
proceeded with the current direction towards the loiter point. Figure 37 and 38 are the 
results. 
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Vehicle Track Data 



Figure 37. Loitering Track after 100 Seconds with a NW Setting Current. 
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Vehicle Track Data 



Figure 38. Loitering Traek after 100 Seeonds with NW Setting Current. 

The characteristics of this track differ from the same approach that the AUV took 
in Figures 28 through 30 is that this pattern is not dominated by “figure 8” tracks, but 
rather an alternating semi-circular pattern. The pattern is still somewhat irregular in 
nature and the track is now bounded by approximately 42 meters in diameter. 
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V. DISCUSSION OF RESULTS 


A. RELATION BETWEEN APPROACH AND CURRENT DIRECTION 

From the simulations and data collected, it was observed that the track the vehicle 
traveled on during loiter is related to the position at where the vehicle was ordered to 
proceed to the loiter point and the direction of the current. If ARIES proceeds to a loiter 
point while traveling against the current, the shape of the loiter track is more predictable 
and regular and the bounded area is minimized. 

The reason for this relationship lies within the Cross Track Error Controller of 
ARIES. When the vehicle is ordered to a loiter point, the heading directly to that position 
becomes the track heading of the vehicle. As the vehicle passes over the loiter point, the 
heading and steering controllers steer the vehicle in an attempt to regain the original track 
heading, therefore, the AUV “circles” the point. As the vehicle circles the loiter point, 
the current direction positions the AUV in such a manner that there is an ample distance 
to proceed on the original track heading towards the loiter point and the process is 
repeated. Eigure 39 below is an illustration of what is being explained above. The 
vehicle is on an original heading of 000 deg T and the current direction is 180 deg T. As 
the vehicle passes over the loiter point, the controllers direct the vehicle is such a manner 
so that it regains the 000 deg T track as it approaches the loiter point. The current 
direction assists the controllers by setting the vehicle far enough away from the loiter 
point that it can settle out on the 000 deg T leg. 
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Figure 39. Relation of Vehicle Approach and Current Direction. 


B. LINE OF SIGHT GUIDANCE INSTABILITY 

Since there is a relationship between the Cross Track Error Guidance and the 
current direction, an analysis of using Line of Sight Guidance only during a loiter was 
conducted. The vehicle does not need to get to the loiter station by a straight line using 
Cross Track Error, it just needs to maintain a predictable and tight track pattern. A 
simple simulation was run with the AUV using Line of Sight Guidance only during a 
loiter and the results can be seen in Eigure 40 below. 
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Vehicle Track Data 
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Figure 40. Line of Sight Guidanee only during a loiter with no eurrent. 

Figure 40 shows that with Line of Sight Guidance only, the vehicle still has an 
erratic and unpredictable track pattern. So the stability of the Line of Sight Guidance was 
next analyzed thoroughly. 


To analyze the stability of the Line of Sight Guidance the closed loop matrix of 
the system was calculated. To calculate this the following was solved; 



V 



r 

¥ 



Y 

- 


0.1492 

0.8895 

where, {M ^A) = 

-0.0507 

-0.4109 


0 


1 




(24) 
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and {M ^E) = 


0.1533 

-0.1650 

0 


leaving equation (24) looking like: 
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0.1492 

0.8895 

0 

o' 
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■ 0.1533 ■ 
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-0.0507 

-0.4109 

0 

0 

r 

+ 

-0.1650 

w 


0 

1 

0 

0 

w 


0 

Y 


0 

0 

U 

0 

Y 


0 


where, U is the forward speed of the vehiele and is ineorporated from 
equation (9). 


d - -ky - kr - kxj/ - ky/^^^ ’ 


where, 


Aw 

dy 


)Y and therefore leaving as: 


(5) = -ky - kjr -k^W^ (~)Y 

s 

where, kj = 0 and kj, k^ are taken from equation (9). 

kj =(-1.543)(2.5394) 
k3=(-1.5)^cr 

where, <T is solved from equation ( 8 ) and 7 = 1.0 and ^ = 0.5 . 


V 


Now that S^. is in terms of 


r 

W 


Y 


the A and B matriees ean be eombined in the 


form: 
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V 

r 

= [A-Bk\ 

r 

¥ 


V 

Y 


Y 


where, [A - Bk] is the closed loop matrix, Ac, of the system. The eigenvalues of 
Ac were found and plotted against the distance to the loiter point, s. Figure 41 below 
shows the results. 


Eigenvalues of LOS Guidance 



Figure 41. Eigenvalues of LOS Guidance. 

Figure 41 shows that the LOS Guidance system is stable farther away than close 
in. The system goes unstable in this scenario approximately 3.9 meters from the loiter 
point. Figure 42 is a closer look at the position at where the system goes unstable with an 
Eigenvalue crossing the zero axis. 
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Eigenvalues of LOS Guidance 



Figure 42. Close In View where Eigenvalues of LOS Guidance Go Unstable. 

Figures 41 and 42 explain the vehicle’s tendencies to be stable when it is a greater 
distance away than when the vehicle is closer in. Under normal operations when the 
vehicle is following a pre-programmed track with no loiter points, the stability of the 
Line of Sight Guidance never becomes a problem because the watch radius around the 
transition points or way points is usually set to approximately 10 meters. Therefore, the 
AUV transitions to the next way point without the Line of Sight Guidance going 
unstable. But when a loiter point is introduced into the program, the vehicle generally 
cannot maintain a steady and predictable shape, but rather a random, unpredictable track 
due to the instability of the Line of Sight Guidance. 
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VI. STABILITY ANALYSIS 


A. LIAPUNOV STABILITY/INSTABILITY THEOREMS 


To investigate the instability of the Line of Sight Guidance even further, the 
theorems of Liapunov were employed. Stability in the sense of the theories from 
Liapunov is concerned with the behavior of a system in the vicinity of an equilibrium 
state. Liapunov stated that if there exists a positive-definite function V(x) that is never 
increasing, the origin is stable [8]. In this case, the origin is the loiter point. 

In mathematical terms, the Liapunov Stability Theorem states if there exists a 
continuously differentiable function V(x) such that: 

1. V(0) = 0 


2. V(x) > 0 for all X 0 


3. 


dV 

dt 


< 0 for all x 

OX OX- 


then the origin of the time-invariant system 
X = fix) 


is stable. 


Liapunov’s Instability Theorem states that if there exists a positive-definite 
function V(x) whose derivative V (x) is non-negative in a region containing the origin, 
then the origin is unstable. 

Applying this theory, a MATLAB program was created to compare the 
Liapunov’s Stability/Instability Theorems to the loitering motions of the ARIES where a 
Liapunov function was chosen and V versus V was plotted. 

The program has the vehicle starting at a point very close to the origin, which is 
the loitering station and the Liapunov function is L = (x-10)^ -l-(y-lO)^. There are no 
current conditions and Line of Sight Guidance is only used. Figures 43 and 44 below 
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provide proof through Liapunov’s Stability and Instability Theorems that the AUV’s Line 
of Sight Guidance becomes unstable when it gets close to the origin (loiter point). 


Vehicle Track Data 



Figure 43. Vehicle Track Data of ARIES. 

Figure 43 starts the AUV very close to its loiter point and the vehicle begins a 
series of right turns to attempt to reach its programmed way point or loiter point in this 
case. Figure 44 below shows how the Line of Sight Guidance is stable as it begins to 
track into the point at a greater distance away, but then goes unstable when it gets a few 
meters from the point. 
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V dot 


Proof of Liapunovs Stability/Instability Theorem 



400 


Figure 44. V dot versus V. 
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VII. CONCLUSIONS AND RECOMMENDATIONS 


Although the loitering track of the ARIES is not predictable in most cases, the 
loitering track of the vehicle is a bounded region for all cases. If a situation arises where 
ARIES is required to maintain a circular pattern on a point or loiter station with no 
deviation in its track, then a series of way points constructed in a circular, octagon, or box 
pattern can be constructed and the vehicle will follow these points. This technique has 
been proven through experiments run with the vehicle in previous missions. 

Shutting the vehicle off at a loiter point is not an option for the following reasons. 
Ultimately the AUV will operate in potentially hostile waters. If the vehicle is shut off at 
its loiter station, the AUV will automatically surface making itself susceptible to enemy 
detection and ultimately compromising its mission. Also, since the AUV is surfaced it 
will still be effected by current conditions and will not maintain position on the loiter 
point. 

ARIES is constructed to be equipped with lateral and vertical thrusters. A 
hovering control law algorithm could be constructed that would utilize the thrusters in the 
vehicle’s attempt to maintain station on one point. This would prove to be useful because 
the instability of the Eine of Sight Guidance would not come into play if such a control 
law existed, however, more power would be consumed in the process. 
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APPENDIX A. MATLAB FILES FOR AUV LOITERING 

The MATLAB code associated and developed for loitering behavior is contained 
on CD-ROM and is obtainable through request from Professor AJ. Healey. This 
appendix contains the MATLAB script file for the ARIES AUV to loiter and continue on 
original track if desired. Currents can be introduced if desired. 

■ LoiterToTrackRun.m 
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APPENDIX B. MATLAB FILES FOR AUV LOITERING 

The MATLAB code associated and developed for loitering behavior is contained 
on CD-ROM and is obtainable through request from Professor AJ. Healey. This 
appendix contains the MATLAB script file for a simple approach to loiter for the ARIES 
AUV. 

■ simpleloiter.m 


63 



THIS PAGE INTENTIONALLY LEET BLANK 


64 



APPENDIX C. MATLAB FILES FOR AUV LOITERING 

The MATLAB code associated and developed for loitering behavior is contained 
on CD-ROM and is obtainable through request from Professor AJ. Healey. This 
appendix contains the MATLAB script file for a simple approach to loiter for the ARIES 
AUV using Line of Sight Guidance only. The eigenvalues of the closed loop LOS 
Guidance are plotted versus distance to the loiter point to show instability. 

■ LOSinstability.m 
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APPENDIX D. MATLAB FILES FOR AUV LOITERING 

The MATLAB code associated and developed for loitering behavior is contained 
on CD-ROM and is obtainable through request from Professor AJ. Healey. This 
appendix contains the MATLAB script file to show the relationship between Liapunov’s 
Stability/Instability Theorem to LOS Guidance. 

■ Reverseinstability.m 
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